#include <localization/maps/lamps_maps.h>

const std::vector<player_point_2d> MappedLampsBBlock() {
  std::vector<player_point_2d> mapped_lamps;

  player_point_2d lamp;

  // Bottom of the image
  lamp = { -27.45, -8.20 };
  lamp.px += 2.00;
  lamp.py -= 2.20;
  mapped_lamps.push_back(lamp);
  lamp.px += 2.40;
  mapped_lamps.push_back(lamp);
  lamp.px += 4.80;
  mapped_lamps.push_back(lamp);
  lamp.px += 5.00;
  mapped_lamps.push_back(lamp);
  lamp.px += 4.80;
  mapped_lamps.push_back(lamp);
  lamp.px += 5.065;
  mapped_lamps.push_back(lamp);
  lamp.px += 4.80;
  mapped_lamps.push_back(lamp);
  lamp.px += 5.00;
  mapped_lamps.push_back(lamp);
  lamp.px += 5.00;
  mapped_lamps.push_back(lamp);
  lamp.px += 4.70;
  mapped_lamps.push_back(lamp);
  lamp.px += 5.10;
  mapped_lamps.push_back(lamp);
  lamp.px += 4.80;
  mapped_lamps.push_back(lamp);

  // Left part of the image
  lamp = { -27.45, -8.20 };
  lamp.px -= 1.40;
  lamp.py += 1.85;
  mapped_lamps.push_back(lamp);
  lamp.py += 3.90;
  mapped_lamps.push_back(lamp);
  lamp.py += 4.07;
  mapped_lamps.push_back(lamp);
  lamp.py += 3.90;
  mapped_lamps.push_back(lamp);

  // Top of the image
  lamp = { -27.45, 7.40 };
  lamp.px += 2.10;
  lamp.py += 2.20;
  mapped_lamps.push_back(lamp);
  lamp.px += 2.40;
  mapped_lamps.push_back(lamp);
  lamp.px += 4.75;
  mapped_lamps.push_back(lamp);
  lamp.px += 5.05;
  mapped_lamps.push_back(lamp);
  lamp.px += 4.70;
  mapped_lamps.push_back(lamp);
  lamp.px += 4.98;
  mapped_lamps.push_back(lamp);
  lamp.px += 4.85;
  mapped_lamps.push_back(lamp);
  lamp.px += 5.10;
  mapped_lamps.push_back(lamp);
  lamp.px += 5.00;
  mapped_lamps.push_back(lamp);
  lamp.py += 3.60;
  mapped_lamps.push_back(lamp);
  lamp.px += 2.15;
  mapped_lamps.push_back(lamp);
  lamp.py -= 3.60;
  mapped_lamps.push_back(lamp);
  lamp.px += 2.35;
  mapped_lamps.push_back(lamp);
  lamp.px += 5.10;
  mapped_lamps.push_back(lamp);
  lamp.px += 4.80;
  mapped_lamps.push_back(lamp);

  // Right part of the image
  lamp = { 27.70, -8.10 };
  lamp.px += 1.40;
  lamp.py += 1.90;
  mapped_lamps.push_back(lamp);
  lamp.py += 4.40;
  mapped_lamps.push_back(lamp);
  lamp.py += 3.48;
  mapped_lamps.push_back(lamp);
  lamp.py += 4.00;
  mapped_lamps.push_back(lamp);

  return mapped_lamps;
}

const std::vector<player_point_2d> MappedLampsC2Corridor() {
  std::vector<player_point_2d> mapped_lamps;

  player_point_2d mapped_lamp;

  double y = -4.0;
  for (int i = 0; i < 15; ++i) {
    mapped_lamp.px = 0.0;
    mapped_lamp.py = y;
    mapped_lamps.push_back(mapped_lamp);
    y += 4.0;
  }

  return mapped_lamps;
}
